# x, y, z, roll, pitch, yaw
float64[3] position
float64[3] orientation